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GYRO AIDED MAGNETIC COMPASS 

CROSS REFERENCE TO RELATED APPLICATIONS 
[0001] This non-provisional United States (U.S.) patent application claims the benefit of 
U.S. Provisional Application No. 60/399,891 filed on July 31, 2002 by inventors Robert W. Levi 
and Robert R. Marshall, titled "Gyro Aided Magnetic Compass." 

STATEMENT REGARDING FEDERALLY SPONSORED RESEARCH OR 

DEVELOPMENT 

[0002] This invention was originated as part of a Federally sponsored Small Business 
Innovation Research (SBIR) project, contract number DAMD17-99-C-9028. The contractor is 
Point Research Corporation, 17150 Newhope Street, Suite 709, Fountain Valley, CA 92708. 
Patent rights for this invention are subject to the Federal Acquisition Regulations (FAR) 
paragraph 52.227-20 — Rights in Data - Small Business Innovation Research Program, and 
DFARS 252.227-7018 Rights in Noncommercial Technical Data and Computer Software-Small 
Business Innovation Research. 

FIELD 

[0003] Various embodiments of the invention pertain to navigation systems. More 
particularly, at least one embodiment of the invention relates to a miniature navigation device, 
method, and system for personnel on foot, land vehicle navigation, marine navigation, and 
aircraft navigation. 
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DESCRIPTION OF RELATED ART 
[0004] Magnetic compasses are commonly used to determine direction and/or the direction 
in which a person or vehicle is heading. However, magnetic compasses are subject to errors 
from nearby magnetic influences, which disturb the magnetic field of the earth. There are other 
less well known sources of error, such as accelerations due to motion. Some of these errors 
experienced on vehicles, such as northerly turning error, have been understood and described in 
literature for some time. Accelerations experienced by a compass worn by a person while 
walking or running can also cause significant errors. 

[0005] The gyroscope and the magnetic compass have been used together in aircraft 
applications for some time, but the integration of the two data sources is typically done using the 
judgment of the human pilot. Recent developments in the field of micro-machined 
electromechanical systems (MEMS) has led to the availability of small, low-power consumption, 
angular rate gyroscopes with electronic data output that can be conveniently used by a 
microcomputer. Electronic compasses are also available with output data compatible with a 
microcomputer. By using a microcontroller with the appropriate software, the data fi'om a 
connected gyroscope and magnetic compass can be blended together to provide a heading 
azimuth that is more accurate and stable than could be obtained firom either sensor separately. 
[0006] MEMS angular rate gyroscopes do not measure angular displacement directly but 
rather the rate of angular motion. However, mathematical integration of angular rate with 
respect to time produces a relative angular displacement or azimuth. Errors in the mathematical 
integration accumulate with time due to quantization effects, scale factor and bias changes, and 
other error sources in the signal output of the gyro. To establish azimuth directions with respect 
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to an earth-referenced coordinate system for navigation, it is necessary to reference the angular 
displacement to some other source of direction information. 

[0007] A magnetic compass provides absolute heading information directly without respect 
to a time history of motion. The output of an angular rate sensor can be numerically integrated 
to produce a heading angle. Although it can track changes in heading reliably in the short term, a 
typical angular rate sensor cannot produce an absolute heading. 
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BRIEF DESCRIPTION OF THE DRAWINGS 
[0008] Figure 1 is a block diagram illustrating a hybrid compass with a magnetic compass, a 
gravity sensor, and a gyroscopic sensor according to one embodiment of an aspect of the 
invention. 

[0009] Figure 2 is a block diagram illustrating a hybrid method for determining heading 
direction according one embodiment of an aspect of the invention. 

[0010] Figure 3 is a block diagram illustrating a method for varying the rate at which the 
magnetic heading is blended with the gyroscopic heading according one embodiment of an 
aspect of the invention. 

[001 1] Figure 4 is a diagram illustrating a general method for combining gyroscopic angular 
rate information with magnetic compass directional information to generate a hybrid directional 
signal according one embodiment of an aspect of the invention. 

[0012] Figure 5 is a block diagram illustrating a hybrid electronic compass according to one 
implementation of the invention. 

[0013] Figure 6 is a diagram illustrating results of a navigation test for a stand-alone 
magnetic compass and a hybrid electronic compass according to one embodiment of the 
invention. 
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DETAILED DESCRIPTION 
[0014] In the following description numerous specific details are set forth in order to 
provide a thorough understanding of the invention. However, one skilled in the art would 
recognize that the invention may be practiced without these specific details. In other instances, 
well known methods, procedures, and/or components have not been described in detail so as not 
to unnecessarily obscure aspects of the invention. 

[0015] In the following description, certain terminology is used to describe certain features 
of one or more embodiments of the invention. For instance, the terms "angular rate sensor", 
"angular velocity sensor", "gyroscope", "gyro", and "gyroscopic sensor" are interchangeably 
used to refer to a device that senses angular velocity or rate of turn and provides a corresponding 
signal. The terms "heading" and "azimuth" are interchangeably used to refer to a fixed direction. 
The terms "blend", i.e., signal blending, and "filtering" refer to any process used to combine two 
or more analog and/or digital signals, either in a weighted or un-weighted scheme and/or 
algorithm. 

[0016] One aspect of an embodiment of the present invention provides a device, system, and 
method for creating two azimuth angle data parameters, one firom a magnetic compass and 
another from the integration of the output of an angular rate sensor. The two azimuth angles are 
combined by a novel method which exploits the strengths of each heading source to overcome 
the weaknesses of the other. 

[0017] Another aspect of an embodiment of the invention also includes a device, system, 
and method for performing automatic calibration of the angular rate sensor to improve 
performance of the combined system. 



LOZAJ\IRV\322582.1 



6 



Patent 
42616.0600 

10018] Figure 1 is a block diagram illustrating an electronic compass with a magnetic sensor 
102, a gravity sensor 104, and a gyroscopic sensor 106 according to one embodiment of one or 
more aspects of the invention. Such an electronic compass may include magnetometers 102 to 
measure the earth's magnetic field and gravity sensors 104 to determine the horizontal plane of 
the compass. The electronic compass also includes an angular rate-sensing gyroscope 106 whose 
sensitive axis coincides with the azimuth-sensing axis of the compass. 

[0019] Figure 2 is a block diagram illustrating a hybrid method for determining heading 
direction according one embodiment of an aspect of the invention. Heading data or information 
is obtained, for example, from a magnetic compass 202 and a gyroscopic sensor 204. The 
heading information provided by the magnetic compass is blended, or filtered, with the 
integrated angular rate data, from the gyroscopic sensor, over time to provide an absolute 
reference heading 206. The overall accuracy of this hybrid heading is assured by blending in the 
directional information from the magnetic compass faster than errors from the gyroscopic 
angular rate sensor can accumulate. 

[0020] Figure 3 is a block diagram illustrating a method for varying the rate at which the 
magnetic heading is blended with the gyroscopic heading according one embodiment of an 
aspect of the invention. Upon determining the accuracy of the magnetic compass 302, the 
blending rate may be made slower 306 when magnetic compass errors are evident 304. 
Otherwise, maintain the current blending rate at which magnetic heading information is blended 
with gyroscopic heading information 308. If the blending rate has been previously reduced, a 
default blending rate may be restored 308. Such operation provides for an adaptive time interval 
or blending rate to improve the accuracy of a hybrid electronic compass depending on the 
reliability of the heading information collected from different sources. 
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[0021] Various methods may be used for deducing that magnetic heading errors are present. 
For example, variations in the three-dimensional magnitude of the measured magnetic field may 
be used to imply a nearby magnetic influence, and/or substantial time-varying accelerations may 
be used to imply errors induced into the compass's tilt compensation mechanism and/or logic. If 
no change in the accuracy of the magnetic compass is detected, then the blending rate is 
maintained or the default blending rate is restored 308. 

[0022] According to one embodiment of the invention, under certain circumstances, the 
output of the hybrid compass may be forced to the magnetic compass value instead of blending it 
with gyroscopic angle data. This may be done for quick corrections and/or at startup. It may 
also be done at any time when other information, such as GPS velocity vectors, can confirm the 
accuracy of the magnetic compass. 

[0023] The information from a gyroscopic sensor may also be used, by itself, to generate a 
heading information. Once a starting orientation is provided, the angular rate data from the 
gyroscopic sensor may be mathematically integrated with respect to time. The resulting 
information may then be used as an alternative to a magnetic compass azimuth. Unfortunately, a 
gyroscopic sensor cannot be a substitute for a magnetic compass indefinitely since it suffers from 
zero offset, scale factor errors and other low-frequency noise which integrate into significant 
errors over time. The amount of time that a gyroscopic sensor can rehably operate with minimal 
error accumulation depends on various factors, including the quality of the gyroscope employed 
in a particular application. 

[0024] There are two primary sources of error when using an angular rate gyro: 1) "zero 
offset" or bias, which is the output of the sensor when it is motionless, and 2) scale factor or 
gain, which is the ratio between the gyro sensor's output and the physical rotation rate. An 
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element of the present invention involves techniques for determining and correcting both factors 
during the use of the invention. For this reason, the time since the last correction is monitored. 
As the time interval since the last correction increases, the risk of error increases and can be 
taken into account. An error in zero offset induces errors in azimuth that are a function of time 
due to the mathematical integration process. An error in gain affects azimuth accuracy only as 
azimuth changes, and then only the net change is affected. The influence of these errors can be 
estimated, in the first case (zero offset) from the elapsed time since the last correction, and, in the 
second case (gain) from the net change in azimuth since the last correction. 
[0025] Thus, various embodiments of the present invention combine the gyroscopic sensor 
information and the magnetic compass data to produce an orientation signal that can replace the 
stand-alone compass azimuth. 

[0026] Figure 4 is a block diagram illustrating a general method for combining gyroscopic 
angular rate information with magnetic compass directional information to generate a hybrid 
directional signal according one embodiment of an aspect of the invention. Heading information 
from a magnetic compass is received 402 used to provide an initial direction 404. The angular 
rate information from a gyroscopic sensor is integrated over time to determine the relative 
change in position and orientation. Together with the initial magnetic heading, the integrated 
angular rate information provides a hybrid directional signal 406. The directional signal may be 
blended with the magnetic compass signal 408, either periodically or as needed, to maintain 
heading accuracy. 

[0027] Figure 5 is a block diagram illustrating a hybrid electronic compass device 500 
according to one implementation of the invention. A geomagnetic sensor 502 provides an initial 
magnetic heading, azimuth, or direction 504 signal that is employed as a starting reference for 
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the system and/or algorithm 508, The output signal from an angular velocity sensor 506 is 
integrated over time to determine the distance and direction(s) of travel. 
[0028] At some time interval, the current geomagnetic sensor's 502 directional information 
is blended or filtered into the hybrid directional signal through a simple filter 516. The blending 
filter may be implemented by calculating a fraction of the difference of the two inputs, namely 
the magnetic compass and integrated gyro data, and adding the difference to one of the inputs at 
uniform intervals to produce the blended output. 

[0029] In order to maintain the accuracy of the hybrid directional signal, the magnetic 
directional signal may be blended or filtered faster than gyroscope errors can accumulate. For 
example, the restoration time constant, or blending time interval, may be approximately thirty 
seconds in one implementation. The extent of this blending can be varied either by changing the 
fraction of the difference added to the input signal or by changing the interval between the 
blending operations. In one implementation of the invention, a portion of the difference between 
compass and gyro azimuth is added to the gyro azimuth. In this manner, the gyroscope's 
integrated angular rate dominates short-term azimuth determination, while the magnetic compass 
stabilizes long-term accuracy. The amount of the difference which is added to the gyro azimuth 
signal during each interval can be varied, as needed, as estimates of compass and gyro accuracy 
dictate. 

[0030] In one implementation of the invention, an adaptive restoration time interval 510 is 
used to blend in the geomagnetic directional signal 502 with the hybrid directional signal. The 
time interval 504 lengthens if the intensity of the overall magnetic field changes substantially, 
which may imply a significant anomaly nearby. Magnetic azimuths are derived from the 
horizontal components of the earth's three-dimensional magnetic field. Since magnetic sensors 
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alone cannot distinguish between horizontal and vertical magnetic components, another set of 
sensors such as accelerometers, may be used to define the magnetic components in the horizontal 
plane, particularly when the magnetometer frame of reference is inclined or tilted. Sensing the 
horizontal plane and resolving the horizontal magnetic components may be termed "tilt 
compensation". When tilt compensation uses accelerometer sensors, blending or filtering the 
compass information back in with the hybrid signal is suspended entirely if accelerometer 
outputs approach the ratings of the devices (i.e., ±2 g) since such an overload may produce 
serious errors in the tilt compensation logic. 

[0031] Since the usefulness of the gyroscopic sensor is strongly dependent upon accurate 
calibration, one implementation of the system of the present invention is capable of adjusting 
both gain 512 and zero offset 514 dynamically. According to various aspects of the present 
invention, the accuracy of the angular rate data may be improved by regular calibration of 1) the 
gyroscope bias, i.e., the output when there is no angular motion (zero offset), and/or 2) 
gyroscope scale factor or gain, i.e., the ratio between gyroscope output and the rate of rotation. 
[0032] One implementation of an embodiment of the invention can estimate both of these 
parameters and update its calculations by taking advantage of opportunities that arise during 
normal use. 

[0033] If the magnetic compass heading is stable then the gyroscopic sensor output can be 
stored at that moment to adjust the zero-offset 514. When the hybrid compass apparatus is 
motionless, angular rotation is, by definition, zero. The output of the sensor can be taken as the 
zero offset at such a time. If the output of the magnetic compass is unchanging, the rotation rate 
is taken to be zero as well, and this will be true even if the compass is experiencing an error due 
to nearby magnetic influences. This test for no rotation can be enhanced by requiring that the 
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bandpass-filtered accelerometer outputs, used in the compass tilt compensation, also be stable or 
small. 

[0034] When a motionless or nearly motionless state is achieved both before and after a 
substantial rotation, the gain of the gyroscopic angular rate sensor can be deduced by comparing 
before-and-after magnetic compass readings with the mathematical integral of the angular rate 
during the same interval. This information may be used to adjust the gyroscope gain calibration 
512. 

[0035] In one implementation of the invention, neither zero offset nor gain calibrations are 
ever changed suddenly by the system. Since dynamic calibration is susceptible to some 
anomalous errors, filtering is used to prevent too much influence from such anomalous events. 
[0036] Thus, both the zero offset and sensor gain for the gyroscopic angular rate sensor may 
be modified during operation. However, there is a possibility that a newly determined value for 
zero offset or sensor gain could be erroneous to some extent. Consequently, one implementation 
of the invention employs the new calibration values, determined during operation, to modify the 
coefficients used during navigation calculations through filtering rather than replacing such 
coefficients outright. Thus, the effects of any single erroneous set of calibration values are 
minimized. 

[0037] In some instances, dynamic calibration may be more effective for zero offset than for 
gain. The opportunities for zero offset measurements are more common and more dependable. 
This is fortunate since accurate zero offset is also more critical for calculation of accurate 
azimuth angle and use in navigation. 

[0038] Figure 6 is a diagram illustrating results of a navigation test for a stand-alone 
magnetic compass and a hybrid electronic compass according to one embodiment of the 
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invention. This diagram shows two tracks of a short dead reckoning navigation test made largely 
between parked cars. One track (dashed line) indicates the path traveled as determined only by 
the magnetic compass. The solid line indicates the same path traveled as determined with 
assistance of a gyroscope according to one implementation of the invention. The route traveled 
ended at exactly the same point it began. So the ability to close the path and the accuracy of the 
orientation (azimuth determination) is easily seen. The track history shown is for a single test 
where the tracks for a magnetic compass device and a hybrid compass device were 
simultaneously recorded. By eliminating any differences in how the course was traversed, this 
guaranteed that the only difference between the two tracks is the influence of the angular rate 
sensor or gyroscope. 

[0039] Substantial distortions in dead reckoning position occurred with the magnetic 
compass (dashed Hne) 601, which appeared to be caused by magnetic effects of parked cars 602 
and 604. By contrast, the hybrid compass device shows a path 603 that has distinct directions, 
accurately determined the start and finish and position of cars 605, 606, and lacks the distortions 
of the magnetic compass path 601. The difference in closing error is another strong indication of 
the effectiveness of the gyro-aided magnetic compass. 

[0040] In one implementation of the invention, the gyroscope or angular rate sensor is not 
used to implement strapdown inertial navigation, as in a three gyroscope - three accelerometer 
Inertial Measurement Unit (IMU), but is instead used for directional guidance only. 
[0041] While certain exemplary embodiments have been described and shown in the 
accompanying drawings, it is to be understood that such embodiments are merely illustrative of 
and not restrictive on the broad invention, and that this invention not be limited to the specific 
constructions and arrangements shown and described, since various other modifications are 
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possible. Those skilled, in the art will appreciate that various adaptations and modifications of 
the just described preferred embodiment can be configured without departing from the scope and 
spirit of the invention. Additionally, it is possible to implement embodiments of the invention or 
some of their features in hardware, programmable devices, firmware, software or a combination 
thereof. The invention or parts of the invention may also be embodied in a processor-readable 
storage medium or machine-readable medium such as a magnetic (e.g., hard drive, floppy drive), 
optical (e.g., compact disk, digital versatile disk, etc), or semiconductor storage medium (volatile 
and non- volatile). Therefore, it is to be understood that, within the scope of the appended claims, 
the invention may be practiced other than as specifically described herein. 
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